clc
close all
clear

%% 创建初始驾驶环境
[scenario, egoVehicle] = createInitialDrivingScenario();
% waypoints = [5 0 0; 900 0 0];
% speed = 50;
% smoothTrajectory(egoVehicle,waypoints,speed);
drivingScenarioDesigner(scenario);
